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START DECELERATION CONTROL^— S701 


FIG. 7 


Tx = 0 


S702 


OBTAIN CURRENT POSITIONAL 
INFORMATION Px FROM ENCODER 
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END DECELERATION CONTROL 
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Vy = (V1 - V2)(2Tx - 3T)Tx 2 / T 3 + V1 


ADDITIONAL-VALUE PID 
CONTROL BY USING 
Vy AS VELOCITY COMMAND VALUE 


I 


S711 


WAIT FOR 1 msec 
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Tx = Tx + 1 
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